#define LX_2_IMU_ANGEL 185//要求2，直线C->D姿态
#define LX_3_IMU_ANGEL_1 38//要求3，4，A->C发车姿态
#define LX_3_IMU_ANGEL_2 57.5//要求3，B->D姿态

#define LX_4_IMU_ANGEL_1 63.5//要求4,A->C行驶姿态，PS：存在惯性不同于发车姿态
#define Speed_WD 40 //弯道速度
#define Speed_ZX 60 //直线速度
